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Method and device for identification of the parameters of an electro-mechanical system _ 

0? 08. 

he present invention relates to amethod for identification of the parameters of 
an electro-mechanical system, in particular an electro-mechanical servo system, comprising a 
mass actuated by a force. Further, the present invention relates to a method for autotuning a 
controller of an electro-mechanical system and a method for controlling such an electro- 
mechanical system. Still further, the invention relates to corresponding devices, in particular 
a device for identification of the parameters of an electro-mechanical system, to an autotuner 
and to a controller, as well as to an electro-mechanical system itself. Finally, the present 
invention relates to a computer program for implementing said methods on a computer. 

A numerical control unit for controlling the position of a movable part, such as 
a machine table, in response to input machining information is known from US 5,159,254. 
The unit employs a servo control loop that can measure the values of the position, velocity, 
acceleration and motor current for the movable part at predetermined times. Using snch 
measured values and, on the basis of a representative spring mass system model, values of 
inertia, mass, viscous friction and sliding friction can be calculated and used for 
automatically optimising the gain and offset parameters applicable to control of the machine. 

Usually, parameter identification of an electro-mechanical system and 
controller tuning are performed by either an expert who needs to perform measurements by 
using special equipment, which is even impossible for highly integrated digital servo loops, 
or by a non-expert who performs a trial and error procedure which often does not result m an 
20 optimised performance. It is therefore an object of the present invention to provide a method 
for identification of the parameters of an electro-mechanical system as well as methods for 
autotuning the controller of such an electro-mechanical system and a method for controlling 
the system which do not require any tuning expertise and special measurement equipment 
and which allow system identification and autotuning to be performed within a very short 
25 time, i.e. which only require several seconds or minutes so that a user can save a lot of time. 
Further, corresponding devices, an electro-mechanical systems and a computer program for 
implementing said methods shall be provided. 

The object is achieved by amethod for system identification as claimed in 

claim 1 comprising the steps of: 
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a) applying a constant force to said electro-mechanical system for a predetermined time 
period, said force having an amplitude at a sub-friction level, 

b) stopping the mass by applying a negative force, 

c) iterating steps a) and b) by increasing the amplitude of the constant force applied in step a) 
5 in each iteration until the velocity of said mass is monotonously increasing during application 

of said constant force, 

d) estimating mass and friction of the electro-mechanical system from the measured 
movement of the mass, 

e) performing steps a) and b) at least for another two times by further increasing the 

10 amplitude of the constant force applied in step a) wherein the amplitude is increased in each 
iteration to at most a maximum level at which the electro-mechanical system does not exceed 
the boundaries of the electro-mechanical system, and 

f) estimating mass, friction and damping of the electro-mechanical system from the measured 

movement of the mass. 
! 5 The invention is based on the idea to obtain a smooth movement of the 

electro-mechanical system as response to the application of a force to the electro-mechanical 
system during which the system remains in the allowable moving range. The smooth 
movement is obtained by setting the amplitude and the time period of the applied force 
carefully. If the predetermined time period is too short the influence of dynamics and virtual 
20 play on the estimators will be significant, virtual play meaning play that is commonly caused 
by a combination of friction and flexibility with the consequence the the actuator may move 
and load does not. If the predetermined time period is too long it may be impossible to 
remain within the allowable moving range or the maximum velocity may be exceeded. 

The force amplitude is found by an iterative procedure. Starting at sub-friction 
25 level the amplitude is raised in small steps until it is detected that the velocity is 

monotonously increasing during application of the constant force. At this point initial 
estimates are generated which are used for predicting the displacements of the subsequent 
steps. 

In the subsequent steps the force amplitude is raised at least for another two 
30 times, in particular with x% and 2x%, respectively, wherein x is chosen such that the 
predicted displacement is smaller than the allowable displacement. The responses to the 
application of these forces are used for identifying friction, mass and damping. 

It shall be noted that the present invention is not limited to translating systems, 
but can be applied to rotating electro-mechanical systems with equal success. Thus, the term 
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"mass" shall be broadly understood as including an inertia (i.e. a rotational mass), and the 
term force shall be broadly understood as including a torque. The present invention is mainly 
applied in electro-mechanical servo systems which are often referred to as double integrator 
systems, but can also be applied in a velocity control loop (single integrator system) or other 

5 electro-mechanical systems. 

Preferably, the initial friction is estimated based on the ratio between the time 
required for acceleration and the time required for stopping the mass. Further, a mass- 
friction-damping mathematical model of the electromechanical system is used for estimating 
mass, friction and damping of the system. Therein, friction estimation may consist of two 

10 estimates, i.e. one estimate for both directions of movement. Based on the differential 

equations of a mass-friction-damper system and using e. g. four position measurements during 
two consecutive movements, i.e. by a total of 8 measurements, all important parameters of 
the system can be estimated. 



In a preferred embodiment the force is applied as a block-wave signal having* 
constant maximum amplitude in step a), i.e. also in the iterations of step a). An alternative is 
a trapezoidal signal. Said signal may also have, after the positive force amplitude, a negative 
force amplitude in order to stop the mass according to step b). Amplitude and time period of 
20 the positive and negative part of the signal may be identical, however, can also be different. 

The required smooth movement is then obtained by setting the amplitude and 
the frequency of the block-wave signal carefully. A preferred range for the predetermined 
time period for application of the constant (positive) force is given in claim 5, i.e. in case of a 
block-wave signal the block-wave frequency is preferably fixed in a range between 0.1Hz 

25 and 50Hz, preferably at 2Hz. 

To determine the initial amplitude of the force to be applied in step a) the 

following further steps are provided in a preferred embodiment: 

aO) applying a force having a monotonously increasing amplitude until the mass starts 

moving and 

30 al) roughly estimating the friction of the electro-mechanical system and determining the 
direction of movement of the mass from the measured movement of the mass, 
which steps are performed prior to step a), in which the initial amplitude of the constant force 
is set lower, in particular 1 to 25% lower, than the friction estimated in step al). 
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Thus, the sub-friction level for the amplitude of the force can be determined. 
Preferably, the force is applied as a ramp signal in step aO). 

The estimation of the friction in step f) is completely independent of the 
damping and mass estimates. Preferably, the movements in step e) are in the same direction. 
5 However, if the direction dependency of friction is also preferred to be determined at least 
four movements are required, two with a positive force amplitude and two with a negative 
force amplitude as claimed in claim 9. 

The object of the invention is further solved by a method for autotuning a 
controller of an electro-mechanical system, wherein the parameters of said electro- 
10 mechanical system are identified by a method as described above, said parameters being used 
to determine the control parameters of a controller, in particular amplification including its 
sign, i.e. its polarity, integrator frequency, differentiator frequency and/or low-pass filter 
settings, so that the electro-mechanical system is operated stable in a low frequency area. 
According to the present invention autotuning can be performed easily without special 
1 5 expertise and measurement equipment within a very short time. 

Preferably the controller comprises a feedback control unit and a feedforward 
control unit. However, the feedforward control unit can also be omitted. 

An automatic bandwidth optimisation is proposed in claim 12. Based on the 
response of the system on a short set-point profile a criterion judges whether increasing the 
20 bandwidth was an improvement. Values of the bandwidth and the bandwidth increase are 

given in claim 14. A criterion forjudging whether an increase of the bandwidth has led to an 
improvement is preferably based on a root-mean-square (RMS) error of the difference 
between the measured movement and the set-point movement, in particular both during 
movement and during settling. This RMS error shows a clear minimum allowing to identify 

25 the optimum bandwidth. 

A method for controlling an electro-mechanical system according to the 
present invention is defined in claim 15. Therein, the parameters of the electro-mechanical 
system are identified as described above. These parameters are used to determine the control 
parameters of the controller such that the electro-mechanical system is operated stable by a 

30 method for autotuning as described above. 

A device for identification of the parameters of an electro-mechanical system 
comprising control means, sensor means and processing means is defined in claim 16. An 
autotuner according to the invention is defined in claim 17. A controller according to the 
invention is defined in claim 18. An electro-mechanical system according to the invention is 
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defined in claim 19. A computer program for implementing the methods according to the 

invention is defined in claim 20. 

The invention will now be explained in more detail with reference to the 

drawings in which: 

5 Fig. 1 shows a simple block diagram of a device for identification of the 

system parameters of an electro-mechanical servo system, 

Fig. 2 shows a flow chart of the method for parameter identification according 

to the invention, 

Figs. 3, 4 show different ramp excitation signals and the measured 

10 displacement and velocity, 

Fig. 5 shows the result of a ramp excitation signal with an experimental set-up, 

Fig. 6 shows a mass-friction-damping model, 

Fig. 7 shows a general electro-mechanical system, 

Fig. 8 shows worst-case errors on a load relative to displacement due to 



15 dynamics, 



20 amplitudes, 
invention, 



Fig. 9 shows a motor controlled fourth order system with friction on the load, 
Fig. 10 shows typical block-wave responses of the motor as shown in Fig. 9, 
Fig. 11 shows a result of the first block-wave signal, 
Figs. 12-14 show the results of a block-wave signal having increased 

Fig. 15 shows a block diagram of a controller according to the present 



25 



30 



Fig. 16 shows bode diagrams of the controller for various settings of the 

controller parameters, 

Fig. 17 shows Nichols plots of the controllers shown in Fig. 16, 
Fig. 18 shows bode diagrams of another controller, 
Fig. 19 shows Nichols plots of the controllers shown in Fig. 18, 
Fig. 20 shows a bode diagram of an open-loop, 

Fig. 21 shows a bode diagram of an open loop, zoomed on low frequencies, 
Fig. 22 shows a flow chart of the method for optimising the bandwidth of the 

controller, 

Fig. 23 illustrates the applied set-point during optimisation, 
Fig. 24 shows measured position, error and controller output for four different 
bandwidth frequencies and 
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Fig. 25 shows the RMS-criterion as a function of the applied bandwidth 

frequency. 



Fig. 1 shows an embodiment of a device for identification of the system 
parameters of an electro-mechanical servo system. Shown are control means 1 for controlling 
the application of a force to the electro-mechanical system 3, an actuator 2 for converting the 
electrical control output signal into a mechanical force to be applied on the mass of the 
electro-mechanical system3, sensor means 4 for measuring the movement of the mass and 
processing means 5 for processing the measured movement and for estimating the desired 
system parameters mass, friction and damping. As explained above the electro-mechanical 
servo system 3 can be a translating system comprising a mass - shown are two masses mi , m 2 
connected by a spring s - actuated by a force F or a rotating system where a mass (inertia i) is 

actuated by a torque T. 
! 5 a particular embodiment of an electro-mechanical servo system under 

particular assumptions will be discussed in the following, which do, however, not limit the 
invention. 

First, the application range and the user requirements shall be discussed. 
The autotuner algorithm according to the present invention has been designed 
20 for electro-mechanical systems comprising a lumped mass, possibly with friction and 
damping, on which a force can be applied. Generally this mass is referred to as a double 
integrator. The lumped mass approximation is always only valid for a certain frequency 
range. The main assumption is that the system behaves like a lumped mass in between 1 and 
10 Hz. More specifically this means: 
25 • No bandwidth limiting resonance below 1 0 Hz. 

• No large phase shifts (>20°) between 1-10 Hz due to e.g. low-pass or delay 
characteristics of amplifiers or sensors. 

• System is not open loop unstable. 
Other important assumptions are: 

30 • System behaves linear except for friction, e.g. inhibits limited play and limited non-linear 
transmissions like cam-shafts etc. 

• Input for the controller is a position, measured with an incremental encoder system. 

For the autotuner algorithm it is assumed that the items below are known to 

the user: 
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. Translating or rotating systems: All systems of which the position measurement is 
performed on a rotating part are considered rotating systems. Systems with a motor 
driving a translating part by some transmission may be rotating if one measures on the 
motor but are defined translating when the measurement is on the translating load. 
5 • Encoder resolution in [incr/revolution] or [incr/m] 

• Maximum displacement [m] or [revolutions] 

• Maximum controller output [V] 

• Sample time [s] (already available in the controller) 

Even though some of the above items may be difficult to specify by the user, 
10 these inputs are expected to be essential for some autotuner steps as well as for reasons of 
safety. It may be possible to apply some smart procedures for detecting the encoder 
resolution or maximum displacement (e.g.: move system manually to maximum position), 
but yet no attention has been given in this direction 

Further, in the following no attention is given to the initialisation ofthe 
15 system. For example the important questions of how to get the system within the allowable 
moving range and how to initialise the measurement system are not discussed in the 
following. Itis assumed that when the autotuner algorithm is started the system is in the 

middle ofthe allowable moving range. 

Next, system parameters and variables and autotuner parameters shall be 

20 illustrated.. 

The system parameters are parameters which are specific for the system to be 
tuned. These parameters may be specified by the user. In some cases they have default values 
as shown in the following table. 



Parameter 



U_MAX 
X_MAX 

T SAMPLE 



unit 



[incr 
] 

[s] 



Defau 
It 



2.5 



1 10 



,-3 



Comment 



Maximum controller output (user specified) 
Maximum displacement/rotation from the middle in 
+ and - direction (user specified) 
Sample time ofthe controller 



25 



System variables are variables containing measurements and computation 
results as shown in the following table. 



Parameter 



Unit 



Comment 
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x 

c_out 
T 

u_break-away 

polarity 
a_block 
a block linear 



xjdnear 

a_blockl 
a__block2 
ICfc_safety 

kdc__safety 

x_expected2 

kdc 

kjv 

kfc 

kfa 

f bw 



Up 
kj> 

kv 

a_setpoint 
vjsetpoint 
xjsetpoint 
setpoint_optim 



[incr] 

[V] 
[s] 
[V] 

H 

[V] 
[V] 

[incr/s] 

[incr] 

[V] 
[V] 
[V] 

[incr/Vs 2 ] 
[incr] 
[incr/Vs 2 ] 
[Vs/incr] 

[V] 

[Vs 2 /incr] 
[Hz] 

[Hz] 
[Hz] 

H 
H 

[incr/s 2 ] 
[incr/s] 
[incr] 
H 
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Position/rotation measurement 
Controller output 
(Discrete) time 

Controller output voltage at which a movement of 
BREAK-AWAY JLEVEL [incr] is detected 
Sign(c_out)/sign(x) 

Amplitude of the block-wave excitation 
Block-wave amplitude at which a linear movement 
was expected 

Average velocity between , " 1 /8*block_frequency and 

V 8*BL0CK_FREQUENCY> f° r 1 = 1*2,3,4 

Maximum displacement when applying 
a_block_linear 

Block-wave amplitude for first linear movement 
Block-wave amplitude for second linear movement 
First friction estimate, used for computing 
x_expected2 

First k_dc estimate, used for computing x_expected2 
Expected displacement when applying a_block2 
mass feedforward gain 
damping feedforward gain 
Friction feedforward gain 
mass feedforward gain 

Bandwidth frequency (0 dB crossing of the open 
loop) 

Breakpoint frequency integrator ( Kl /2») 
Low-pass filter comer frequency 
Gain of proportional part of controller 
Gain of derivative part of controller 
Acceleration setpoint during optimisation 
Maximum velocity setpoint during optimisation 
Maximum displacement during optimisation 
Object containing the setpoint to be used during 
optimisation 
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The autotuner parameters axe parameters which characterise some actions of 



parameter u 


nit E 


lefault C 


omment 


RAMP_SLOPE f 
BREAK- [ 
AWAYLEVEL 

A_BREAK- 
AW AY_S AFET 


Ws] 0 
incr] 1 

( 


3 "s 
00 is 

tl 
1 

).9 5 
< 


lope of ramp function 

Movement level at which it is expected that 

tie controller output exceeds the stick-slip 

evel 

Safety factor for break-away level 
computation 


Y 

BLOCKJFREQU 


[Hz] 


2 


Frequency block-wave 


ENCY 

XJVUNJBLOCK 


[m] 


0.5 10' 3 


Displacement level below which the 
movement is considered non-linear, 


V MTM BLOCK 

JR. 

V_MIN_BLOCK 


Frev] 
[incr/s] 


0.17 

liner. 

/t_samp 


translating system 

Rotation level below which the movement 
is considered non-linear, rotating system 
Velocity level below which the movement 
is considered non-linear 


SETTLE_TIME_ 
BLOCK 

DELTA_BLOCK 


[s] 

m 


LB 
0.3 

0.1 


Waiting time for the system to settle after 

applying a one period block-wave 

Voltage with which the block-wave 
amplitude is increased when the movement 


A_BLOCK_FAC 
TORI 

A_BLOCK_FAC 
TOR2 

A_EXPECTED_ 
SAFETY 




1.25 

1.5 

0.5 


was considered non linear. 1 
Factor by which a_block_linear is increased 
for the first linear movement 
Factor by which a_block_linear is increased 
for the second linear movement 
Safety factor for computing expected 
displacement when applying 
A_BLOCK_FACTOR2 j 
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INITIALBAND 


[Hz] 


5 


Initial bandwidth frequency 


WIDTH 








PHIJPM 


ft 


45 


Required phase margin (phase of the open 








loop at fbw) 


BETA_LP 


H 


0.65 


Relative damping of the low-pass filter 


INTEGRATORR 


H 


0.31 


Ratio between fbw and fj 


ATIO 








LOWPASSRATI 
O 

T_SETPOBSfT_0 


[-] 


30 


Ratio between fi p and fbw 


M 


0.2 


Setpoint duration during optimisation 


PTIM 








SETTLE_TEME_ 


[s] 


0.3 


Waiting time after applying a setpoint for 


OPTIM 






optimisation. 


BWJNCREASE 


[-] 


1.19 


Factor with which the bandwidth is 


_F ACTOR 






increased during one optimisation step 



The method for identification of the system parameters shall be explained in 
the following with reference to the flow chart of Fig. 2. All steps of the method will be 
illustrated further by simulated or experimental measurements shown in a number of further 
5 figures. 

First, ramp excitation of step SI shall be explained. 

The main goal of the first step S 1 is to obtain a starting voltage for the block- 
wave analysis. By applying a slowly increasing voltage and by tracing the position 
measurement the break-away voltage can be detected. The break-away voltage is a measure 
10 for stick-slip which, for dry-lubricated systems, will be close to the friction. For systems with 
a lot of play or virtual play the estimate may be poor. 

The two important autotuner parameters to be set are the slope of the ramp 
function and the break-away detection level, i.e. the displacement at which the system is 
expected to have exceeded the stick-slip level. 
1 5 The break-away level detection has to detect the stick-slip level. This may be 

hard as is shown in Fig. 3 and Fig. 4, which show the results after applying two different 
ramp functions to the system. Before reaching the actual stick-slip level (of 0.48 V is this 
example) a displacement of over 10 incr. is detected. This is easily observed in Fig. 3. Due to 
effects like play the actual system starts moving before reaching the actual stick-slip level. 
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The break-away detection level should be large enough to be able to deal with some play. On 
the other hand: if the break-away level detection is chosen too large an over-estimation of the 
break-away voltage may be obtained and this may result in a dangerous (too large) starting 

voltage of the block-wave analysis. 
5 Inaparticular practical embodiment abreak-away level detection of 100 incr. 

was found to be efficient. As it is hard to obtain better information on theoretical grounds a 
break-away detection level of 100 incr. is proposed as an example. 

The importance of the slope of the ramp can also be explained with reference 
to Fig. 3 and Fig. 4. When applying a relatively steep slope (Fig. 3) the displacement 
10 increases relatively slow. Then it is hard to estimate stick-slip. Abreak-away level of 20 
increments or 100 increment gives completely different results. So the break-away voltage 
then depends merely on the break-away detection level. 

Fig. 4 presents the results after applying a ramp with as small slope: the 
measured displacement increases very rapidly after exceeding the stick-slip level. Now the 
15 computed break-away voltage will be less sensitive for the break-away-level. An obvious 
disadvantage of a small slope is the large duration of the first step of the autotuning 
algorithm. As an example a slope of 0.2 V/s is proposed. 

After applying the ramp function the system brakes on friction or damping (if 

present). 

20 ~ Damping and friction levels are unknown at this point, so for safety the • 

controller has to make sure the system brakes. This can be performed by reversing the 
controller output immediately after exceeding the break-away-level, and to hold this output 

until the velocity equals zero. 

Most systems will have some direction dependency in the stick-slip level and 
25 thus also in the break-away voltage. It is expected that the direction dependency is small and 
that an estimator for one direction is also a sufficient accurate estimator for the opposite 
direction. 

As a movement is performed the polarity can be set. With the assumption that 
the initial polarity in the controller is set to 1 the polarity can be computed by: 
30 POLARITY - SIGN(C 0U t)*SIGN(X). 

The proposed algorithm has been applied to a 4 th order experimental set-up. 
The results are shown in Fig. 5. The experimental set-up is self-braking due to friction and 
stops almost immediately after reversing the sign of the controller output. It should be noted 
that the position measurement does not shoot away like in Fig. 4 even though both results 
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presented in Fig. 4 and Fig. 5 are measured on the same set-up. Apparently the non-linear 
behaviour at voltage levels close to friction is not very repeatable. 

Thus, as a result of the ramp excitation (SI) a first estimate of the fiction and 
direction of movement is obtained (S2) which are used in the following block-wave 
5 excitation (S3) to be explained next. 

For the autotuner algorithm it is assumed that the system to be tuned can be 
modelled as a mass-friction-damper system comprising a mass m 2 and a damper b as shown 
in Fig. 6. It was found that a friction-mass model having no damper was not sufficient to 

obtain the desired accuracy. 
10 The model can be described with the differential equations: 

F + F f =mx + bx (Equation 1) 

Assuming a constant force F is applied, solving the velocity with the assumption that x(0)=x 0 
and x(0) = v 0 gives the relation: 

F + F ' t - A (x(t) -x 0 ) + v 0 . (Equation 2) 



15 



i(0 = 

m m 



Now also x can be solved, with x(0) = x 0 the relation can be written as: 
x{t) = miF + Ff) {e* -l + A<y^(l-^V*o. (Equations) 

If damping tends to zero ( e * « u *L r + ±f *Yt* ) and v 0 =0 and x 0 =0 the relation simplifies to: 

m v m / 



F + F f 2 

limx(0= - ~ t • 
t>-*o 2m 

20 If x is measured at three time points after applying a constant force up to T t (and known 
initial conditions) b/m can be solved. The three time points are chosen as respectively T B , 
2T B , 4T B with T B = V 4 Ti = V 4 V 2 T W ock (a fourth of one half period of the block-wave) 

. b ln( ^T ) (Equation 4) 

R _ \ x(4T B ) - 2x(2T B ) + x(0) thp imping breakpoint frequency (frequency 

B ~ix(2T B )-2x(T B ) + x(fi) 

25 below which damping dominates the system). 
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After solving b / m it is possible to estimate K* (estimator for V m ) if another movement with a 
different block-wave amplitude is performed: 

(*»CT.) - *i ( r »)(~) t (Equation 5) 



The above equation can also be used for two movements with identical initial velocities. 
When the damping tends to zero the above formula simplifies to: 

,. * o *,(r,)-* t (r,) 

max. dc — z ~ , ^pr 



Now also an estimate of the damping can be obtained (using equation 4): 

ln(— ^— ) (Equation 6) 

6= — ^F 1 -- 

10 With the estimate of K< c and the measured displacement during applying A block2 it is possible 
to estimate coulomb friction (K/ c ) 

0 Xl(r,> A (Equation 7) 

— — A.uf~.y> * 



t,— j — w 

* m 



With help of Equation 5 it can be shown that the friction estimator can be written such that it 
is completely independent of the damping and mass estimates. It should be noted that when 

15 using the above equations 5 and 7 the movements as a result of A^ki and Aw«*2 should be 
in the same direction. So, if the direction dependency of friction is also preferred to be 
computed 4 movements are required (Awo*i, A b ,ock2 and -Awo*i, -Abiocia). Equation 7 can 
also be used when has been computed in a certain direction (two movements required) 
and the friction is computed for the opposite direction (at cost of error propagation of the K* 

20 and b / m estimate). Then three movements are required for computing friction in two directions 

(Abiocki, Abiock2 and -Abiocta). 

For reasons of accuracy in the K fc estimate in both directions it is proposed to 

perform 4 movements (W,, A*** and - Wi, -M with the autotuner. 

For the analysis two responses are needed in one direction resulting from a 
25 constant force (S3). As also abraking mechanism has to be applied (S4) since the system is 
in open loop the most convenient wave form is a block-wave.. 

For applying a block-wave two parameters have to be set carefully: 
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1) Block-wave frequency 

2) Block- wave amplitude 

The frequency of the block has to be that small that the system behaves in a 
(quasi) static way. Mostly, system dynamics can be represented by a fourth order system 
5 comprising two masses m, and m 2 connected by a spring and a damper as shown in Fig. 7. 

The first resonance of systems for which the autotuner is used is assumed to be 
above 10 Hz. After applying a step on the force it depends on the level of vibrations relative 
to the absolute displacement (x, or x 2 ) for how long the dynamics significantly influences the 
position measurement. It can be shown that the maximum error (defined as position 
10 difference between motor and load position) equals e ml =F/k„ Assuming that mi =m 2 the 
amplitude of the motor vibration is: e= ±L , with F the input force and k the transmission 

stifmess. The position (x) of the motor can be approximated with: x ^JL- t * using the 



assumption that the worst case resonance frequency equals 10 Hz (= ) and 

assuming that mi = m 2 = m the relation can be rewritten as: x = x-£— f ■ 

/(2/rlO) 1 

1 5 Now the relative error can be computed: 



e 



(Equation 8) 



x IOOttV 

This relation means mat for example after 0.25 s the error caused by 4 th order dynamics is " 
smaller than 1.6 % of the resulting displacement, even when the system is undamped. The 
formula is illustrated with help of Fig. 8 which shows worst-case errors due to dynamics 
20 simulated for a 10Hz resonance 4* order system with several values for damping, including 
0=0. 

It should be noted that the dynamics may significantly influence the response 
below 0.1 s. For systems with low-frequent dynamics it may be much better to choose other 
time points for analysis. For example: choose 4 equidistant time-points between 0.1 s and 
25 0.25 s for analysis. Worst case error in the position due to dynamics is less than 10 %. The 
initial velocity and position can easily be dealt with in the formulas for the estimators. 

When the motor mass m, is larger than the load mass m 2 the same relation, i.e. 
equation 8, can be used for a worst case estimate. However, when Ihe mass of the load is 
larger than the motor mass, influence of dynamics will be worse. Systems are usually 
30 designed to have a larger motor mass than load mass. 
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A second consideration for the duration of the block-wave is that the motor 
may start resonating in the virtual play. If the duration of the constant force is larger than 0.1 
secondsamovementinthe virtual play can be distinguished from a movement outsxde the 
virtual play. This is explained in the block-wave amplitude section below. 

Because of the influence of dynamics and the possibility to check if the 
movement is outside the virtual play it is proposed to choose the block-wave frequency as 2 

Hz 

Now the block-wave amplitude shall be discussed. It is not possible to 
establish a sensible block-wave amplitude with the available system knowledge (user input 
and results from ramp-analysis). For mis reason ft. ampntude of the block-wave is increased 
in steps until a good movement is measured. A star, level for the block-wave amplitude has 
been derived in the ramp-function analysis (steps SI, S2). For safety it is proposed to choose 
the initial block-wave amplitude as A_BRBAK-AWAY_SAFETY • ubreak-away. As an 
example it is proposed to choose A_BREAK-AWAY_SAFETY as 0.9. 
5 Ferdetectmgagoodmovementtwoitemsareimportant all parts are movmg 

(not justthe motor), and the system behaves linear. 

AmottonofallpartsshaUnowbeacHeved.Acomplex S ystemisamotor ■ 

controlled system which drives by some transmission a load which is subjected to more , 
Kcnonmanmemo to r,asdepic«edmFig.9sbowingamo.orcon^Uedfourthorder system. 

,0 with friction on the load. Because of virtual play the system may start moving/ resonahng m 
' t besnfnressofmep 1 ay(wimafte< 1 nencywhichmaybesmallermanlOH Z asmeresonanng 

mass is larger when me load is in standstill: for m, - m 2 the new resonant frequency 
becomes 1V< Hz) . This behaviour is shownin Fig. 10 showing a typical simulated 
response of the meter of a fourth order system with friction on the load, m,-mi and a 10Hz 
25 resonance.onwmchoneperiodofaZHzblcck-waveisapplied.Fig.lOashowsannndamped 

system and Fig. 10b shows a system with a relative damping of 3=0.95. 

Fig. 10 shows the simulation results of applying a block-wave with an 
amplitude jnst below the friction level to a fourth order system like depicted in Fig. 9. This 
resonating movement in the virtual play can be distinguished from a movement of the 
30 completesystembyconsidertagthemspl^^ 

moving mass (he velocity increases (e.g. refer to Fig. 13) whilst for a movement in the virtual 
pl ay the velocity erossea zero within the 0.25 duration of the constent force. This behavionr 
also imposes a limit on theblock-wave frequency as for a 0.1 duration of tire ennstan, force it 
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will be very hard to distinguish the movement in the play from a free mass movement (refer 
to Fig. 10). 

A reliable check if the movement is in the virtual play or outside the virtual 
play is possible on the velocity signal: if the movement is outside the virtual play the velocity 
increases in time (proportional with the time if damping is absent). The proposed check is to 
divide the constant force interval ( l / 2 T b i 0 ck = 0.25 [s]) in four equidistant sections and to 
compute the average velocity for these intervals. The section are defined by 0-T B -2T B -3T B - 
4T B with T B = V 4 V 2 T bl ock = 0.0625 s. Then the following check (S5) must be performed: 
V 4 >V 3 >V 2 >V l >0 
or 

x(4T B )-x(3T B ) x@T B )-x(2T B ) x(2T B )-x(\T B ) ^ x(T B )-x(0) > Q 
T B T B T B T B 

Besides virtual play, actual play may exist in the system. If the system moves in the play the 

movement is like a free moving mass. This can not be distinguished from a movement 

outside the play. So this is very hard to deal with, and it can only be assumed that the actual 

play is small. 

Now, linearity shall be discussed. Effects like cogging or play may have 
significant influence for small movements and as a consequence the estimators may be poor. 
Cogging depends on the number of magnets/coils in a motor which for rotating motors 
typically varies between 6 and 12. The velocity check of step S5 may not be sufficient for 
detecting these non-linear effects. Adding a check on minimal displacement may prevent 
mistakes. For rotating systems a minimal displacement of x l$ rotation and for translating 
systems 0.5 mm will in most cases guarantee that the influence of cogging and play is small. 
Care must be taken that 0.5 mm or X U rotation is not close to the maximum displacement 
(close means 10 % of the maximum displacement); in that case a minimal displacement of 
Vio of the maximum displacement is preferred. 

When the velocity check (S5) or the minimal displacement check have not 
been passed the amplitude of the block-wave must be increased (S6). The new amplitude 
must be that small that the system remains within its limits, so a small raising of the 
amplitude improves safety. However, when the steps are too small the block-wave analysis 
may consume quite some time. As an example, a step size of 0. 1 V is proposed. 

When the checks (S5) have been passed for the first time a linear movement 
has been obtained. The corresponding block-wave amplitude (defined as Aimear) is mostly just 
above the friction level. It was found in experiments that this first linear movement did not 
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result in the best estimators; however, a preliminary estimate for mass and friction can be 
found (S7). 

Therefore, it is proposed to increase the block-wave amplitude in step S8 and 
to perform further block-wave excitations (S10) including a stop of the mass (SI 1). It is 
5 expected generally that increasing the amplitude with 25 % and 50 % (at least two 
movements are required for analysis; a counter is applied in step S13) suffices: 

Abiockl = 1 -25 Aunear and A b iock2= 1 -5 Aunear- 

Numerous variations are possible for computing A b i ock i and A bh ck2- The best 
way is to verify the settings on several set-ups. Usually it is expected that it is possible to 
10 apply a force of 1.5 times the friction force without exceeding maximum displacement levels. 

Care must be taken that me system boundaries (maximum displacement and 

Umax ) are not exceeded (S9). After applying A line ar it is possible to predict displacements. 

When assuming zero damping an initial estimate Kdd of K<5 C can be obtained by: 

k _ , xQZzxW ,withTi halfaperiodoftheblock-wave(0.25sfortheproposed2Hz 

15 block-wave) and with ^ = , m which is me time-point were me direction of 

h 

movement changes. Kd C is in the presence of damping an overestimation. 

Now it can be checked (S9) if the expected displacement is smaller than 50 % 
of the maximal displacement. The 50 % is a safety margin: the system starts braking at Tj but 
it may take up to time 2T t before the system actually stops. The total displacement is then 
20 maximal 2 x(Ti). 

**p—.<T,) =i0W. <± x ™ 

If the above inequities apply, the new block-waves with Abiocki and Abiocki can 
25 be applied. If not, other block-wave amplitudes have to be chosen (S12). Another constraint 
to be dealt with is the maximum controller output. 

The following dealing with constraints is proposed: 

• Block-wave amplitude constraints: 

If Abiockz is larger than IW it is proposed to choose Awockz = U max and Abiocki = 

30 {Ainear+Ablock2}/2 

• Displacement constraints: 

if x exp ected2 is larger than w it is proposed to choose 
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, fmg p- _ ( 2 f hi**) 2 x ™* +j j> (then x expecte d2 equals Xmax) and 

K dc T l A <fc 

Ahlockl = {Aiinear + Ablock2}/2. 

The amplitude variation between A b i 0 cki and Awocia should be large enough to 
5 ensure a good resolution. For systems with little friction it may be wiser to choose Ab, ockl and 
Ab,ock2 for example as respectively Ai i „ear+0.1U ma x and Aimear+O^U.nax, instead of a certain 
percentage of Aimear (approximately equal to friction). 

Finally (S14), good estimates for friction, mass and damping are obtained by 

equations 5-7 above. 

I o The above has been verified in an experimental set-up. First, a one-period 

block-wave with an amplitude of 90 % of tW-away is applied. U b reak-away was established at 
0.48 V , which is just above the friction level of 0.46 V. The results of the first block-wave 
are shown graphically in Fig. 11. 

1 5 For judging linearity the (average) velocity for 4 equidistant intervals between 

0 and 0.25 s (constant force part) is computed. The velocities computed are respectively: Vi= 
1475, v 2 =903, v 3 =419 and v 4 =1226 [incr/s]. As this is not an increasing sequence the 
movement is considered not linear (or in the virtual play) and the block-wave amplitude is 
raised with 0. 1 V (S6) and applied again (S3). The new results are shown in Fig. 12. 

20 Again the (average) velocity is computed for 4 equidistant intervals between 0 

and 0.25 s: Vi= 2459, v 2 =5419, v 3 =71 13 and v 4 =7903 [incr/s]. An equivalent check would be 
to check if the displacement is monotonously increasing. Now the movement is judged to be 
linear, so Aw=0.532. Now an initial K fc and K<ic is estimated (S7; for reasons of safety 
only): 

25 # /e =0.45 [V] (computed with T,=0.25 s and Tv=o=0.271 s). 

^=5.6 10 6 [incr/Vs 2 ] 

Both estimates are reasonably accurate (actual values (0.48 and 4.8 10 6 ). It 
should be noted that Ka c is overestimated, which is typical for this estimation method. 

Now it is checked whether it is possible to raise A Wo ck with another 50 % (S8, 

30 S9). 

Ablock2 =1.5 Aiinear 



=±0W a 6 10 3 [incr] 



^ expected 
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As Xexpected is smaller than 50 % of the maximum displacement it is expected to 
be possible to raise the amplitude with 25% (A bIock 0 and 50 % (A^). First the block-wave 
with amplitude ^ Wocft /=1.25 A bhcklin ear is applied. The results are shown in Fig. 13. The 
maximum displacement (relative to the initial position) was measured to be 3.3 10 3 [incr]. 

Next, the block-wave with amplitude A b iock2 is applied, the results are shown 
in Fig. 14. The maximum displacement (relative to the initial position) was measured to be 
5.3 10 3 [incr] (x expec ted=6 10 3 proved to be a good safety estimate) 

Now all data needed for processing in one direction is acquired. The 
successive movements have been shown in Figs. 1 1 - 14. It should be noted that the position 
remains close to zero, even after 4 block-waves in one direction. 

The same experiments have also been performed in the opposite direction. 
The estimators, resulting from the equations presented above, are presented in 
the tables below: 



b/m estimation 


Positive direction 


T b 








0.062 [s] 




/ M = 0.55 Hz 




x(4T b ) 




( b / m =/ M -2ir) 




4669 [incr] 








x(2T b ) 








1338 [incr] 








x(T b ) 


= 362 






[incr] 






Negative direction 


T b 

0.062 [s] 
x(4T b ) 
3538 [incr] 
x(2T b ) 
992 [incr] 
x(T b ) 
269 [incr] 


/ w = 0.41 Hz 



1 5 After averaging: f u = 0.48 Hz 
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K<j c estimation 


Positive direction 


Xi(Ti) 
3047 
X2CT0 
4669 

Abiocki = 0.665 
Abiock2 = 0.798 


Kd C =5.12 10 6 [incr/Vs 2 ] 


Negative direction 


x.CTO 
2206 
x 2 (T.) 
3538 

Abiocki = -0.540 
A b iock2 = -0.648 


Kdc=4.83 1 0 6 [incr/Vs 2 ] 


After averaging: K<i c = 4.97 10 6 


Kf C estimation 


Positive direction 


Xi(Ti) 
3047 
x 2 (T0 
4669 

Abiocki = 0.665 
Abiocki - 0.798 


K fc =0.412[V] 


Negative direction 


Xi(Ti) 
2206 
x 2 (Ti) 
3538 

Abiocki = -0.540 
Abi 0 ck2 = -0.648 


K fc =-0.371 [V] 



With the estimated K<j c also an estimate for the absolute damping can be 
5 computed (equation 6): The results for the positive and negative direction are respectively: b 
= 6.8 10" 7 and 6 = 5.3 1(T 7 

The results are very accurate, especially the most important estimator Kd C 
estimate is very good. It was analysed how estimators are influenced by block-wave 
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amplitudes and if estimator errors in b / m propagate in the other estimators. It appeared that 
estimator errors in b / m hardly propagate. 

Next, controller tuning shall be explained. Fig. 15 shows a block diagram of a 
control loop including a controller 6 according to the present invention. The controller 6 
comprises an autotuner 61 for determining the control parameters of the controller based on 
the parameters of the electro-mechanical system 3 estimated as described above. Therefore, 
the autotuner 61 preferably comprises control means and processing means as shown in Fig. 
1 for estimating said system parameters. However, said control means and processing means 
may also be provided outside the autotuner 61 or outside the controller 6. The controller 6 
further comprises a trajectory generator 62 for generating a trajectory to be fed to a feedback 
control unit 63 and feedforward control unit 64. Further a signal generator 65 is provided for 
generating test signals. The elements 62 to 65 are controlled by the autotuner, and their 
outputs are switched on a common output by a switch 66 connected to the actuator 2. It 
should be noted that elements 62 and 65 could also be external devices. 

The most important feedback controller objective is to stabilise the system. In 
the autotuner this is realised by providing a phase lead at the bandwidth frequency. For 
controller tuning the Kp and K v part are used for providing the necessary amplification as 
well as for providing the phase lead. The phase lead has to be chosen large as it can not be 
excluded that there is phase loss in the system at the bandwidth frequency (e.g. phase lag in 
amplifier etc.) 

It is also possible, and in some cases desirable, to tune a 2 nd order low-pass 
filter and an integrator provided in the controller. The 2 nd order low-pass filter reduces the 
high frequent amplification which usually results in a smoother (less noisy) controller output. 
As a consequence the controller tuning seems more reliable to the user. Disadvantage is that 
it gives additional phase lag at the bandwidth frequency. This can be compensated for by 
increasing K v , but this results in less amplification at low frequencies (for a certain 
bandwidth and phase margin). The integrator may be used for 1) improving setpoint tracking 
by increased low-frequent gain, 2) improve settling by realising a zero-error in the presence 
of friction 3) increasing the settling speed by activating the integrator at the end of the 
setpoint. Disadvantage is that it also results in a phase lag at the bandwidth frequency (which 
also can be compensated by K v ). 

The term "bandwidth" shall be understood as the (most low-frequent, 
descending) OdB crossing of the open loop frequency response function of x/C in wherein x is 



10 
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ft. on«pn, (position or rotation measure en.) of the system and U is fte control inpnt 

signal. u 
The controller (consisting of K,, K v , integrator and low-pass filter) can be 

approximated (continuous description) with the relation 

with the proportional gain, K v the derivative gain, K, the integrator gain, f lp the 2 nd order 
low pass filter frequency and ft, the damping of the low pass filter. The controller has 
breakpoints at the frequencies: fi -W*-f and^. 

With the controller a certain phase margin and a certain amplification at the 
bandwidth frequency shaU be established. For computing the K, and K v formulas are derived 
below It is assumed that first the low-pass filter and optionally the integrator have been set 
(rules of thumb for the settings will be discussed later) and then to compute K p and K v to 
establish the desired phase margin and amplification. 

Due to the integrator a phase loss at the bandwidth frequency of 

is obtained. The low pass filter results in an additional phase loss of 
9 >, P C/ bw ) = arctan^ )J _ (2 ^ )a J- 

Also the phase loss due to calculation delay can be computed 
(so for a calculation delay of 0.1 ms this results in a phase loss of 0. 18 at 5 Hz). 

From the system ( H „_ ■) a damping estimate is obtained. The phase 

syxten s 2 + 2?f fd S 

provided by damping at the bandwidth frequency equals 

The phase lead to be given by the K,-K v filter now equals 

- <Pr» + + <p>u^+<Pctr^ ' *W (/*) 

with <fe, m the desired phase margin. 

The Kp-K v part of the controller provides aphase lead of 



20 



25 
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^ mn J^^. (Equations 

It should be noted that a maximum phase lead of 90° can be achieved by the 
Kp-Kv controller part. The KpK v part also has to realise a amplification such that the open 
loop gain equals one at the bandwidth frequency. 

The amplitude of the open loop at the bandwidth frequency can be computed 

from 

| HMtJ 1= 1 = ^K + {K v 2^YK^<J^)K, p {f^K^M^ (Equation 10) 
with: 



10 W^-f^I 

K (/ ) , ^ 

Using equations 9 and 10 Kp and K v can be solved from the estimated Kdc,. 
estimated damping, the desired phase margin and bandwidth frequency. 
From equation 9 it follows that: 

15 K _ tan (^*v)-g)> ^ (Equation 11) 

Substituting in equation 10 Kp can be solved: 

K = cos(^) . (Equation 12) 

P ^ V j(em(Aw)-^«)(/6M')^-integrotor(/6»') 

Now, with help of equation 11 K v can be solved as well: 

K = sin ^*v) (Equation 13) 

v 2rf bw K sys(em (fi >w )Kip(fbw)K integra i or (f 6w ) 

20 So, when an integrator frequency, a low-pass frequency and low-pass damping 

have been set the Kp and K v can be computed such that the feedback requirements (phase 
margin and bandwidth) are satisfied. It depends on the user requirements whether or not the 
integrator is advantageous. 
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Next, the proposed methods for tuning the controller respectively with and 
without integrator are explained. For both strategies the tuning aims at a 5 Hz bandwidth 
system with 45° phase margin 

First, controller tuning without integrator shall be discussed. 

For the autotuner it is hard to determine an optimal setting for the low-pass 
filter. When tuning manually, one usually hears (noise) and sees (noisy controller output) 
whether a low pass filter is required. The low-pas filter can also be used for dealing with 
dynamics when a frequency response function has been measured. None of the above 
information is available, so it is best to start with a best guess for the low pass filter. Roughly 
two 'best guesses are available' (although all in between values maybe as good or better as 
well): 

1) minimise the high frequent gain with respect to the stability margins, 

2) minimise the effect of phase loss due to the low-pass filter and be satisfied with a 
'reasonable' high frequent amplification. 

Both strategies have been simulated. Fig. 16 shows the controller computed 
with equations 1 1 and 12 for several low-pass filter settings (fi p =<** fi p =3.8, f bw (T) and fi p =30, 
f bw (H), for all controllers f bw =5Hz> phase margin = 45° and ft p =0.65). The resulting stability 
margins are visualised by applying the controller to a double integrator and presenting the 
Nichols plot in Fig. 17. From Fig. 16 it can be concluded that minimising the low-pass 
frequency results in a loss of the low-frequent amplification of almost 6 dB. As low-frequent 
amplification is usually one of the main controller objectives the strategy will not be optimal 
(unless a strong high frequent reduction is required). It seems more sensible to start with a 
'moderate' low pass filter frequency of e.g. fi p =30 f bw which hardly reduces the low-pass 
amplification but still results in a high frequent reduction of 15 dB. The damping of the low- 
pass filter has been set such that it closely matches the 9dB - 45° M-circle of the Nichols plot 
(0 lp =O,65). After setting the low-pass filter one can measure the noise on the controller output 
as a measure for undesired high frequent amplification. A measure for noise would be the 
RMS value of the high frequent (AC) component of the controller output when the system is 
in standstill. The high frequent component can be obtained by applying a high pass filter to 
the controller output: 

It is proposed to choose N as 20 samples as an example. 



PHNL020748EPP 



L * 06.08.2002 
If Anoise exceeds a certain value (proposed is 0.5 V) the low-pass filter 

frequency is decreased to fi p =3.8f bw and the KpK v settings are computed again and the 

controller is applied. 

An exemplary proposed tuning is: 

fi p =30ft w (decrease only if measure of noise exceeds maximum level) 

j8, p =0.65 

Kp andKv to match the desired gain and phase margin according to equation 
12 and equation 13. 

Next, controller tuning with integrator shall be discussed. 

As mentioned above adding the integrator improves disturbance rejection, 
tracking and provides a zero error in the presence of friction. It does not necessarily improve 
settling and it gives a phase lag at the bandwidth frequency which has to be compensated for 
by increasing the K v . When an integrator is desired it is usually set to maximal gain without 
violating the stability margins (phase margin in this case). For an integrator gain which 
corresponds with an integrator breakpoint frequency of 0.3 1 ft w the bode diagram is shown in 
Fig. 18. The Nichols plots are shown in Fig. 19. Again two settings of the low-pass filter 
have been applied; one 'moderate* which aims for maximal low-frequent amplification and > 
one which aims for a minimal high frequent gain without violating the stability margins ; 
(f lp =3.8, f bw (I) and fip=30, J5> W (II); for comparison a pure Kp-K v is shown as well; for all 
controllers f bw =5 Hz, phase margin = 45° and jSi p =0,65). Aiming for a minimal high frequent 
amplification results in a loss of low frequent amplification of almost 10 dB (compared to the 
controller with fip==30fbw). This is only recommended when a lot of noise is present. The 
same criterion as proposed for controller tuning without integrator can be used for setting the 
low-pass filter. 

An exemplary proposed tuning is: 
fi p = 30fbw (decrease if measure of noise exceeds maximum level) 
jSip- 0.65 

Ki=0.31f bw 27T (fi=0.31f bw ). 

Kp andKy to match the desired gain and phase margin according to equation 
12 and equation 13. 

With help of the estimates as described above the controller tuning has been 
computed as proposed above with low-pass filter and integrator and implemented in 
dSPACE. The measured open loop FRF of the actual system (with the dSPACE controller) 
and autotuner model (i.e. the mass-damper model and controller formula) are shown in Figs. 
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20 and 21. The measured bandwidth was 4.9 Hz and the phase margin was 44° (so very close 
to the target of 5 Hz and 45°). It can be concluded that the estimated parameters and the 
proposed controller tuning results in the desired objectives. 

Now, an optimisation of the described method shall be explained with 
reference to the flow chart of Fig. 22. First the system parameters are estimated (S20) and the 
control parameters are determined by the method of autotuning (S21) as described above. 
The method of autotuning results in a first bandwidth at which a first movement is performed 
in step S22. This means that the controller is used to generate a short (e.g. for 0.2s) trajectory 
which the system is forced to follow using feedback control and friction feedforward. 
Depending on the quality of the feedback tuning this results in a small or large error, i.e. a 
difference between trajectory and measure position. 

For performing a bandwidth optimisation it is proposed to increase the 
bandwidth in steps, i.e. to perform autotuning (S23) to obtain an increased bandwidth. After 
every step of autotuning (S23) a movement is performed (S24) and the autotuner decides on a 
criterion whether increasing the bandwidth (or actually the expected bandwidth) was an 
improvement (S25). Improvement means that the error, i.e. the difference between trajectory 
and measured position, during and after movement has become smaller. If there was an 
improvement the algorithm returns back to step S23 to further increase the bandwidth, while 
in the negative case the best bandwidth is selected (S26) and the algorithm terminates. 

Important parameters to be set for this step are: 

• Step size for increasing the bandwidth 

• Movement setpoint 

• Optimisation criterion 

For choosing the step size the items below are of importance: 

• avoid an excessive optimisation time 

• avoid stability problems: when increasing the bandwidth stability problems may occur. 
The step has to be that small that the risk of becoming unstable in one step is minimal. 

• resolution has to be acceptable for users. 

A double integrator system (-2 slope) implies that when increasing the 
bandwidth with a factor k the magnitude increases with k 2 . A magnitude raising of 3 dB is 
usually acceptable (i.e. the system will not become unstable). A magnitude raising of 6 dB 
(or bandwidth frequency raising of V2 ) is already risky (starting from a relatively safe 
amplitude margin of 9 dB the amplitude margin may be reduced to 3 dB in one step, a 3 dB 
amplitude margin is very close to instability). By performing simulations or more 
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experiments it is possible to check how risky a raising of 6 dB actually is. These checks have 
not yet been performed and for that it is proposed to remain on the safe side and the increase 
the controller gain with 3 dB per step. So the bandwidth is increased in steps of ^2 = 1.19 . 
Then in 18 steps a 100 Hz bandwidth system can be achieved starting from a 5 Hz bandwidth 
5 system. Whether or not the duration of the optimisation is acceptable depends on the setpoint 
duration which is discussed below. 

The movement setpoint and optimisation criterion are closely linked to each 
other. The representative movement at least has to deal with the issues: 

• The movement has to be large and fast enough to ensure that the system behaves linearly 
10 • The movement has to be small enough to remain within the limit s 

• Force has to remain smaller than the maximum force 

Other movement characteristics depend on the chosen optimisation criterion. 
Basically two approaches are possible: 

1. Criterion based on settling behaviour. As the focus is on settling, a second order setpoint 
1 5 profile without constant velocity part will do. The most important characteristic is the 

acceleration duration. If for example the setpoint duration is 0.1 s, the typical frequency": 
contents is at 10 Hz. In that case a 5 Hz bandwidth controller may perform better than a' 
10 Hz bandwidth controller (due to the peak in the sensitivity curve) and the optimisation 
will stop in a local minim um . The setpoint should be chosen such that is 'slower' than the 
20 bandwidth frequency: a good setpoint duration would be 0.2 s. Theory about setpoints in 

relation to bandwidth frequencies and dynamics is known as input-shaping. 

2. Criterion based on tracking. Here, a setpoint with a constant velocity part has to be 
created. The dynamics may significantly influence the constant velocity during 0.4 s. The 
dynamics also depend on the bandwidth frequency and the acceleration duration. For 

25 certain combinations of bandwidth frequency and acceleration duration the performance 

will be worse than for a lower bandwidth frequency. So one has to wait until the 
influence of dynamics is negligible (wait for 0.4 s). 

In experiments it was found that using the second approach it is very hard to 
avoid a local optimum. The second approach also takes more time because of the large 
30 constant velocity part. Experimentally good results were found using the first approach with 
a short setpoint duration in combination with the optimisation criterion as explained below. 
Now, feedforward/feedback during optimisation will be explained. 
The feedback tuning will be like explained above. All parameters (integrator 
and low-pass) have to be implemented during optimisation as they influence performance and 
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stability Less clear is, if it is advantageous to activate the feedforward parameters during 
optimisation. The friction part of the feedforward is meant to compensate for non-hnear 
behaviour and it ensures that the system starts moving at the beginning of the setpomt But rf, 
for example, the complete feedforward tuning is perfect and the system behaves like a mass- 
5 fiiction-dampersystemtherewiUbenodifferenoeintheresponseof aSHzandlOHz 

bandwidth system. For this, the acceleration and damping part of the feedforward should not 
be activated during optimisation. This theory is also supported by experimental results. 

A reasonable value for the setpoint acceleration a* may be found by choosmg 
the same acceleration as previously used (safely) during the block-wave analysis: 

10 = 0W 2 ~ K fi) K da • 

The maximum velocity is chosen such that the total setpoint duration equals 
the desired setpoint duration (proposed: 0.2 s). 

The setpoint displacement can now also be computed: 

The setpoint is shown in Fig. 23. Only the magnitude of the setpoint is 
adjusted to the identified system characteristics, the shape will always be the same. No care 
has to be taken that the maximum displacement is exceeded as the acceleration magmtude is 
-- equal to the acceleration during application of A,^, only now the acceleration tone 1S 
shorter. So also the maximum controller output will not be exceeded. The duration will be 
acceptable: one movement takes 0.2 s, another 0.3 s will suffice for settling. So for each step 
0 5 s are required, within 1 8 steps (total time 9 s) a 100 Hz bandwidth can be achieved. 

For judging the performance the RMS value of the error during (1) settling or 
(2) during the setpoint or (3) during both setpoint and settling can be considered. It was found 
that the latter seems most reliable. (1) is not recommended as it is possible that the systems at 
the end of the setpoint stops on friction (after that is may take quite some time before the 
integrator manages to overcome friction). Using (2) may result in missing errors after the 
setpoint. It is proposed to use the combination of both. 

For theproposed movement other criteria canbe applied as well for judging 

30 the performance, such as: 

the RMS of the error after the setpoint during 0.3s; 
the RMS of the error during the setpoint only (0.2s); 
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the RMS of the error during 0.5s; 

the RMS of the controller output during 0.5s. 

The proposed optimisation is as follows: Apply 2 nd order setpoint without 
constant velocity part with a duration of 0.2 [s] and an acceleration magnitude of A block2 -K fc . 
5 Compute the RMS value of error during the 0.2 [s] setpoint and 0.3 [s] settling. 

In an experimental verification, first the 5 Hz feedback tuning is applied based 
on the results obtained from the block-wave analysis (see Fig. 20). The applied setpoint is 
shown in Fig. 23. Next, the movement is performed, first for a bandwidth of 5 Hz, next for a 
bandwidth of V2 5 Hz. After that is it is decided whether the bandwidth raising was an 
10 improvement. In case of an improvement the bandwidth is again increased with a factor i/l 
In case of no improvement the optimisation is stopped and the previous controller assumed to 
optimal and is implemented again. Fig. 24a-d show the response of the system for several 
bandwidth frequencies (i.e. for 10Hz, 16.8Hz, 33.6Hz and 40Hz). 

The proposed error criterion as a function of the bandwidth frequency is 
shown in Fig. 25. Up to a bandwidth frequency of 33.6 Hz the criterion is decreasing (i.e. 
improvement). At 40 Hz the criterion detects a worsening of the performance, and it is 
decided to apply a bandwidth of 33.6 Hz and to stop the optimisation. 

Other optimisation criteria are computed and possible. However, the RMS 
error has been shown to be the best criterion. 

Another movement well worth examining is a movement as a result of a step 
on the position setpoint. Dealing with friction is the main challenge in this strategy. 

Another alternative strategy would be to perform a 'representative movement' 
and ask the user if he wants to increase the bandwidth. After increasing the bandwidth the 
movement is repeated and the results are shown graphically. 

Even with small steps in the bandwidth raising there is still a risk of becoming 
unstable in one optimisation step (e.g. the presence of badly damped resonances). It is 
recommended to apply a measure for instability (e.g. controller output), when instability is 
detected a switch to an old (stable) controller can be made. 

From the above the following can be concluded. 

The proposed autotuner algorithm performed very well on the experimental 
set-up. Within several seconds estimates are obtained for damping, friction and the mass. The 
estimator of the mass and friction were within 10 % accurate. The damping estimate was a 
little bit less accurate, but still within 20 % of its actual value. By means of analysis and 



20 



25 



30 



PHNL020748EPP 




30 06.08.2002 
simulation of dynamics and other common system characteristics like play, virtual play and 
stick slip it has also been made likely that the autotuner will perform well on other set-ups. 

It proved to be important to estimate damping as well. For the experimental 
set-up estimator errors of over 25 % were made if damping was neglected. 

5 The autotuner method is different from other known methods. The main 

difference is that it was found that analysing the response of a block-wave excitation in open 
loop leads to more accurate results than could be obtained from a closed-loop sine excitation 
and closed loop feedforward parameter estimation. Moreover, a block-wave analysis is very 
efficient. From four movements, which only take 0.5 s each, all important parameters can be 

10 estimated. 

For the feedback controller, tuning formulas are proposed which compute Kp 
and K v settings which provide the correct phase lead and amplification, given the mass and 
damping estimate, integrator frequency and low-pass filter settings. There are no settings 
which are optimal for all systems. Generally it is recommended to use the low-pass filter only 

15 if noise is present on the controller output. A rule of thumb (based on maximum low-frequent 
gain) is proposed for the integrator setting. 

An automatic bandwidth optimisation is proposed. The optimisation 
performed well on the experimental set-up. Based on the response of the system on a short 
setpoint profile a criterion judges whether increasing the bandwidth was an improvement. 

20 The proposed criterion was selected as it was the only tested criterion which could avoid a 
local optimum during the optimisation process. 
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CLAIMS: 



1 • Method for identification of the parameters of an electro-mechanical system, 

in particular an electro-mechanical servo system, comprising a mass actuated by a force, said 
method comprising the steps of: 

a) applying a constant force to said electro-mechanical system for a predetermined time 
period, said force having an amplitude at a sub-friction level, 

b) stopping the mass by applying a negative force, 

c) iterating steps a) and b) by increasing the amplitude of the constant force applied in step a) 
in each iteration until the velocity of said mass is monotonously increasing during application 
of said constant force, 

d) estimating mass and friction of the electro-mechanical system from the measured 
movement of the mass, 

e) performing steps a) and b) at least for another two times by further increasing the 
amplitude of the constant force applied in step a) wherein the amplitude is increased in each 
iteration to at most a maximum level at which the electro-mechanical system does not exceed 
the boundaries of the electro-mechanical system, and 

f) estimating mass, friction and damping of the electro-mechanical system from the measured 
movement of the mass. 



2 - Method as claimed in claim 1, wherein the friction is estimated based on the 
ratio between the time required for acceleration and the time required for stopping the mass. 

3 - Method as claimed in claim 1, wherein mass, friction and damping are 
estimated based on a mathematical model of the electro-mechanical system. 

4 - Method as claimed in claim 1, wherein the force is applied as a block-wave 
signal having a constant maximum amplitude in step a). 



5 - Method as claimed in claim 1, wherein said predetermined time period is in a 

range from 0.01 to 5 seconds, in particular 0.25 seconds. 
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6. Method as claimed in claim 1, further comprising the steps of: 

aO) applying a force having a monotonously increasing amplitude until the mass starts 
moving and 

al) roughly estimating the friction of the electro-mechanical system and determining the 
direction of movement of the mass from the measured movement of the mass, 
which steps are performed prior to step a), in which the initial amplitude of the constant force 
is set lower, in particular 1 to 25% lower, than the friction estimated in step al). 

7. Method as claimed in claim 6, wherein the force is applied as a ramp signal in 
step aO). 

8. Method as claimed in claim 1, wherein the amplitude of the constant force 
applied in the iterations of step e) is increased by 25% in a first iteration and by 50% in a 
second iteration. 

9. Method as claimed in claim 1, wherein the force is applied as a block-wave 
signal having a constant maximum amplitude in the iterations of step e), wherein in a first 
number of iterations, in particular in two first iterations, a force with a positive amplitude and 
in a second number of iterations, in particular in two subsequent iterations, a force with a 
negative amplitude, in particular having the same absolute value as said positive amplitude, is 
applied. 

10. Method for autotuning a controller of an electro-mechanical system, in 
particular an electro-mechanical servo system, comprising a mass actuated by a force, 
wherein the parameters of said electro-mechanical system are identified by a method as 
claimed in claim 1, said parameters being used to determine the control parameters of the 
controller, in particular amplification including its sign, integrator frequency, differentiation 
frequency and/or low-pass filter settings, such that the electro-mechanical system is operated 
stable in a low frequency area. 

1 1 . Method as claimed in claim 10, wherein said controller comprises a feedback 
control unit and a feedforward control unit. 
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12. Method as claimed in claim 10, further comprising a step of optimising the 
bandwidth of the controller by: 

i) performing a predetermined movement at an initial bandwidth, 

ii) autotuning the controller to obtain an increased bandwidth, 

iii) performing the predetermined movement at the increased bandwidth, 

iv) checking whether said bandwidth increase led to an improvement, 

v) iterating steps ii) to iv) by increasing the bandwidth and performing the predetermined 
bandwidth until the step of checking in step iv) shows no further improvement. 

13. Method as claimed in claim 12, wherein the criterion for checking whether the 
bandwidth increase led to an improvement is based on a root-mean-square error of the 
difference between the measured movement and the set-point movement, in particular both 
during movement and during settling. 

14. Method as claimed in claim 12, wherein the first bandwidth is in the range 
between 1 and 10 Hz, in particular 5 Hz, and wherein the bandwidth is increased in each 
iteration by a factor in the range between 1 and 2, in particular 2 0 25 . 

15. Method for controlling an electro-mechanical system, in particular an electro- 
mechanical servo system, comprising a mass actuated by a force, wherein the parameters of 
said electro-mechanical system are identified by a method as claimed in claim 1, said 
parameters being used to determine the control parameters of the controller such that the 
electro-mechanical system is operated stable by a method for autotuning as claimed in claim 
10. 



16. Device for identification of the parameters of an electro-mechanical system, ii 

particular an electro-mechanical servo system, comprising a mass actuated by a force, 
comprising: 

- control means for 

a) applying a constant force to said electro-mechanical system for a predetermined time 
period, said force having an amplitude at a sub-friction level, 

b) stopping the mass by applying a negative force, and 
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c) iterating steps a) and b) by increasing the amplitude of the constant force applied in 
step a) in each iteration until the velocity of said mass is monotonously increasing 
during application of said constant force, 

- sensor means for measuring the movement of the mass, and 

- processing means for initially estimating mass and friction of the electro-mechanical system 
from the measured movement of the mass, and for finally estimating mass, friction and 
damping of the electro-mechanical system from the measured movement of the mass after 
steps a) and b) have been performed at least for another two times by further increasing the 
amplitude of the constant force applied in step a) wherein the amplitude is increased in each 
iteration to at most a maximum level at which the electro-mechanical system does not exceed 
the boundaries of the electro-mechanical system. 

17. Autotuner for autotuning a controller of an electro-mechanical system, in 
particular an electro-mechanical servo system, comprising a mass actuated by a force, 
comprising: 

- a device for identification of the parameters of said electro-mechanical system as claimed in 
claim 16, and 

- processing means for determining the control parameters of the controller, in particular 
amplification including its sign, integrator frequency, differentiator frequency and/or low- 
pass filter settings, such that the electro-mechanical system is operated stable in a low 
frequency area. 

18. Controller for controlling an electro-mechanical system, in particular an 
electro-mechanical servo system, comprising a mass actuated by a force, comprising: 

- an autotuner as claimed in claim 17 for determining the control parameters of the controller, 
in particular amplification including its sign, integrator frequency, differentiator frequency 
and/or low-pass filter settings, such that the electro-mechanical system is operated stable in a 
low frequency, and 

- control means for controlling the electro-mechanical system. 

1 9. Electro-mechanical system comprising a mass actuated by a force and a 
controller for controlling the electro-mechanical system as claimed in claim 18. 
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2 0. Computer program comprising computer program code for causing a computer 

to perform the steps of the method as claimed in claim 1, 10 or 15 when said program is run 
on a computer. 
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ABSTRACT: 1 

07 zoo* 



The present invention relates to a method for identification of the parameters 
of an electro-mechanical system, in particular an electro-mechanical servo system, 
comprising a mass actuated by a force. Based on the time response of the system on the 
application of a constant force, in particular on a block-wave output of the system, the 
parameters friction, mass and damping of the system are estimated. This allows accurate 
feedback and feedforward tuning of the controller. Further, control optimisation can be 
performed by an iterative procedure. 

(Fig. 15) 
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